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摘 要 : 针对 直线 单 级 倒立 摆 在 模型 参数 不 确定 和 外 部 扰动 情况 下 的 稳定 控制 问题 ， 提 出 一 种 自 适 应 积分 反 步 控制 
策略 ， 采 用 拉 格 朗 上 日 方程 建立 倒立 摆 系 统 的 运动 学 模型 。 为 减少 稳 态 误差 ， 将 误差 积分 项 引入 反 步 法 ， 设 计 了 倒立 
摆 的 控制 器 。 对 含有 未 知 参 数 的 系统 非 线性 状态 微分 方程 ， Lyapunov 函数 推导 出 系统 未 知 参 数 的 自 适 
应 更 新 律 ， 消 弱 了 参数 不 确定 性 的 影响 。 将 自 适 应 积分 反 步 控制 与 一 般 的 反 步 法 控制 ， 模 糊 控 制 及 神经 网 络 控制 的 
仿真 结果 进行 了 对 比 ， 并 在 LabVIEW 开发 环境 下 进行 了 实物 实验 。 结 果 表 明 ， 自 适应 积分 反 步 法 可 以 较为 迅速 且 
精确 地 完成 稳定 控制 ， 较 好 地 克服 系统 参数 不 确定 及 外 部 扰动 的 影响 ， 具 有 较 强 的 鲁 棒 性 
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Adaptive integral backstepping control strategy for inverted pendulum 


Liu Chengji, Tao Yufan, Guo Siwen, Chen Yihang 
(School of Mechanical Electronic & Information Engineering, China University of Mining & Technology, Beijing 100083, 
China) 


Abstract: This paper proposed an adaptive integral backstepping control strategy to solve the stability control problem of 
inverted pendulum system with uncertain model parameters and external disturbance. It established the kinematics model of 
inverted pendulum system by using Lagrange equation. In order to reduce the steady state error, it introduced error integral 
term into backstepping method to design the controller of inverted pendulum. For the nonlinear state differential equations 
of system with unknown parameters, it designed a proper Lyapunov function to derive an adaptive update law for the 
unknown parameters of the system, and weakened the influence of parameter uncertainty. Then it compared the simulation 
results of adaptive integral backstepping control with results of general backstepping control, fuzzy control and neural 
network control and carried out the physical experiments in the LabVIEW development environment. The results show that 
the adaptive integral backstepping method which has good robustness can complete the stability control quickly and 
accurately, it can also overcome the uncertainty of the system parameters and the influence of external disturbance. 
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0 引言 反 步 法 是 一 种 构造 性 方法 ， 具 有 较 强 的 系统 性 、 结 构 怕 
和 有 灵 活性， 在 设计 一 大 类 严格 参数 非 线性 系统 的 自 适应 控 表 
倒立 摆 系 统 作为 控制 领域 的 一 种 重要 研究 平台 具有 非 线 。 器 时 十 分 有 效 。 其 作为 一 种 非 线性 控制 的 设计 工具 ,不 仅 能 够 
性 、 欠 驱动 、 不 稳定 、 强 耦合 等 特点 。 近 年 来 ， 很 多 学 者 对 “避免 取消 一 些 有 用 的 非 线性 特性 ,而 且 镇 定 函数 及 控 表 
倒立 摆 系 统 的 稳定 控制 进行 了 大 量 的 研究 3, 主要 的 控制 方 。 Lyapunov 函数 的 选择 亦 非常 灵活 ， 反 馈 控制 律 及 相关 控 和 
法 包括 线性 化 控制 方法 , 如 PID, LQR 等 ; 变 结 构 控 制 方法 ， Lyapunov 函数 的 构造 是 系统 的 ,能 够 较 好 地 处 理 系统 常 参 数 
如 滑 模 控制 等 ， 智 能 控制 方法 ， 如 模糊 控制 ， 神 经 网 络 控制 ”不 确定 性 和 一 般 的 不 确定 性 干扰 009。 其 设计 思路 为 ， 将 整个 
等 。 文 献 [4,5] 应 用 PID 和 LQR 控制 方法 来 控制 非 线 性 倒立 。 系统 分 解 成 不 超过 系统 阶 数 的 多 个 子 系统 ， 从 高 阶 系统 的 内 
摆 系 统 ， 将 线性 理论 控制 方法 应 用 于 线性 化 处 理 过 的 倒立 摆 ，” 核 开始 ， 逐 步 设 计 每 个 子 系统 各 自 的 控制 律 ， 最 终 递 推出 整 
模型 ， 但 其 局 限 性 在 于 要 求 系统 线性 化 后 误差 较 小 、 模 型 简 个 系统 的 控制 律 。 
单 。 考 虑 到 倒立 摆 系 统 的 非 线性 特点 ， 为 消 弱 不 确定 性 的 影 本 文 首先 应 用 拉 格 朗 日 方程 建立 倒立 摆 系 统 的 运动 学 模 
响 ， 文 献 [6] 在 滑 模 控制 的 基础 上 ， 对 其 切换 增益 ; 行 参 数 模 ”型 00， 区 别 于 传统 的 反 步 法 ， 将 误差 积分 环节 加 入 到 控制 器 
糊 化， 取得 了 一 定 的 控制 效果 。 模 糊 控制 虽然 不 需要 精确 的 ”的 设计 当中 。 通 过 为 每 个 子 系统 单独 设立 适当 的 积分 函数 ， 
数学 模型 ， 但 常规 模糊 控制 策略 的 局 限 在 于 难以 建立 起 完善 ” 在 每 个 误差 变量 当中 增加 了 积分 项 ， 减 少 了 系统 的 稳 态 误差 
的 模糊 控制 规则 来 保证 其 控制 效果 ,需要 结合 其 他 控制 方法 ， 55。 然后 将 自 适 应 控制 与 反 步 法 相 结合 ， 针 对 控制 器 中 参 
如 LQR 和 PID 等 "533。 因 此 文献 [9] 基 于 模糊 控制 加 入 了 参数 数 的 不 确定 性 ， 运 用 所 设计 的 自 适 应 律 实现 对 控制 器 中 不 确 
自 调整 的 思想 ， 根 据 误 差 及 其 变化 率 ， 对 模糊 控制 参数 进行 ”” 定 参数 的 在 线 估 计 ， 补 偿 了 系统 参数 不 确定 性 的 影响 ， 并 且 
在 线 自 调整 ， 取 得 了 较 好 的 控制 效果 。 在 倒立 摆 受 到 外 部 扰动 时 ， 自 适应 律 会 实时 调整 输入 参数 ， 
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从 而 实时 改变 控制 器 的 输入 ， 使 得 自 适应 积分 反 步 法 比 传统 
反 步 法 拥有 更 强 的 抗 扰 动 性 能 , 极 大 的 增强 了 系统 的 鲁 棒 性 。 
最 后 通过 与 传统 反 步 法 ， 模 糊 控制 和 神经 网 络 控制 的 仿真 对 
比 及 LabVIEW 下 的 实物 实验 ， 验 证 了 该 方法 的 优越 性 。 


1 ”倒立 摆 的 运动 学 模型 


本 文 以 直线 单 级 倒立 摆 为 研究 对 象 ， 采 用 拉 格 朗 日 方程 
建立 了 系统 运动 学 模型 。 拉 格 朗 日 方程 不 需要 牛顿 定律 ， 不 
必 考 虑 约束 力 , 使 力学 问题 的 运算 简化 , 避免 了 繁琐 的 计算 。 
将 系统 的 运动 学 模型 转换 为 运动 控制 二 阶 模型 ， 再 利用 反 步 
法 建立 倒立 摆 系 统 控制 器 。 直 线 倒立 摆 的 模型 如 图 1 所 示 。 


图 1 倒立 摆 受 力 分 析 示 意图 
Fig.1 Diagram of force analysis of inverted pendulum 

F 为 作用 在 小 车 上 的 力 , M 入 w 分 别 为 小 车 和 摆 杆 的 质 

量 ，1 为 摆 杆 质心 到 摆 杆 和 小 车 铵 接点 的 长 度 ，9 为 摆 杆 与 

竖 直 方向 的 夹 角 ，x 为 小 车 的 位 置 ，&8 为 重力 加 速度 ，f 为 

小 车 和 轨道 的 摩擦 力 。 

对 于 系统 模型 进行 分 析 时 ， 由 于 摆 杆 和 小 车 匀 接 处 的 摩 


擦 力 对 系统 影响 较 小 ， 这 里 忽略 不 计 。 系 统 拉 格 朗 日 方程 如 
下 : 
4 名]- or ,OV ,op 5 0) 
dt \ 00 Og; 0q; 69， 
其 中 : 7 为 系统 动能 ; V 为 系统 势能 ，2 为 摩擦 消耗 能 量 ; 4 
为 广义 坐标 。 摆 杆 动能 
也 -你 + (cos OF + 
[Getlsin oO) } (2) 
小 车 动能 为 
1 ra 
也 = (3) 
以 摆 杆 和 小 车 匀 接 点 水 平面 为 0 势能 面 。 摆 杆 势能 为 
Vi=mglcos0 (4) 
小 车 势能 在 运动 过 程 中 不 变 。 当 4 =x 时 , 拉 格 朗 日 方程 
为 (这 里 忽略 摩擦 力 ) 
F=(M+mix+mlOcosO—mlO’ sinO (5) 
当 g=9 时 ， 拉 格 朗 日 方程 为 
(T+ml?)O+mlicosO—mgslsin0 =0 (6) 
结合 式 (5)(6) 得 到 力 和 角度 9 的 关系 方程 为 
F=-AdsecO+htanb+h (Ocos0 -0 sing) (7) 


式 (7) 为 带 有 未 知 参数 的 系统 方程 ， 其 中 多， 如 ， 扣 分 别 


为 
4 tm ) (8) 
ml 
4=(M +meg (9) 


,=ml (10) 
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2 ” 自 适 应 积分 反 步 控制 器 设计 


2.1 控制 器 设计 
倒立 摆 的 控制 器 设计 可 以 分 为 以 下 四 步 : 
a) 根 据 倒 立 摆 模 型 方程 式 (7)~(10) 得 到 系统 的 状态 方程 
式 (11)~(13)。 
定义 误差 变量 
到 中 间 虚 拟 控制 量 
为 保证 < 渐进 稳定 定 ， 设 计 积 分 函数 式 (19)。 
b) 由 式 (18)(19) 得 到 系统 稳定 控制 器 式 (20)。 
令 克 =9， 避 =6 得 到 式 (7) 的 状态 空间 方程 


<， 设 计 积分 项 (15) 保 证 。 的 渐进 稳定 ， 得 


Zz 


本 


he 


Fi | 


厂 三 加 (11) 
F-h Sin x (12) 
其 中 
h(x)=—h secn + cosa (13) 
首先 定义 误差 变量 为 
en (14) 


为 希望 得 到 的 系统 稳定 时 摆 杆 
渐进 稳定 ,首先 选用 如 下 积分 函数 
z=é+kie (15) 
得 到 虚拟 控制 量 z， 当 z 收敛 至 0 时 ,， 有 6e=-he，, 误差 e 
渐 近 收敛 至 0， 其 中 心 为 误差 增益 且 >0， 求 z 的 微分 得 


竖 直 方向 夹 角 , 为 使 系统 


ZzZ=E+ke (16) 
进而 得 到 
Z= 芜 一 加 十 KE (17) 
根据 系统 模型 式 (12)， 将 襄 代 入 式 (17) 得 


—F + tanx —AR sinx +k 
é 


2= 雯 十 pe (18) 
(19) 


积分 作用 保证 了 z 的 收敛 性 ， 其 中 石 为 控 和 

L >0 。 由 式 (18) 和 (19) 联 立 得 到 下 式 
F=k,zt+h tanan 一 大 各 sin x+(X 十 后 6)( 一 4。 
Sec 嫩 十 心 cos 罗 ) (20) 

式 (20) 即 为 系统 的 控制 器 。 
2.2 自 适 应 律 的 推导 
适应 控制 所 讨论 的 对 象 通常 结构 已 知 ， 参 数 未 知 ， 对 
于 模型 的 和 扰动 的 先 验 知识 较 少 ， 在 系统 的 运行 过 程 中 不 断 
提取 有 关 模 型 的 信息 ， 使 参数 不 断 更 新 ， 趋 近 于 真实 值 。 这 
里 结合 Lyapunoyv 稳定 性 定理 设计 估计 参数 的 更 新 律 。 设 1， 


黎 ， 妈 的 估计 值 分 别 为 入 ， 称 ， 称 ， 由 式 (20) 得 到 下 式 : 


量 : 的 增益 


驯 


F=kzt+h tanx 一 外 让 Sin 2 十 


(X, + ke)(-A secx +A cosx) (21) 


这 里 未 知 参数 的 估计 误差 为 和 =4 -有 ， 克 =- 也 ， 克 = 起， 
将 式 (21) 代 入 式 (18) 得 


z= 庆 二 RE+[ 一 kz 二 读 tan 一 称 庆 Sin 一 
(secni + cosx)(E, +ke)]/ h(n) (22) 


为 求 得 丸 ，， 避 的 自 适 应 更 新 律 ， 定 义 Lyapunov 函 


数 
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1 和 
V=—zh(x)+ 十 
2 (5) 2 


(23) 


wm ,oa ,0 为 自 适 应 增益 常量 , 且 w >0,ow >0,os>0 。 对 式 (23) 


两 边关 于 时 间 求 导 , 则 有 
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和 三 一 02Ztan 为 (30) 
(31) 


和 = QZ Ex Sin x 一 (X + ke)cosn ] 


此 即 参数 入 ， 称 ， 反 的 自 适应 更 新 律 。 


『- 2414 (24) 
[24 [24 [24 
将 式 (13) 和 (22) 代 入 ， 则 有 系统 仿 
i Ft 3.1 “仿真 模型 与 参数 设置 
I 根据 建立 的 直线 单 级 倒立 摆 运 动 学 模型 和 设计 的 自 适应 
i 站 本 积分 反 步 控制 器 ， 应 用 MATLAB/Simulink 构建 控制 系统 ， 
人 | 《5) 并 对 其 控制 器 和 倒立 摆 模 型 部 分 进行 封装 ， 主 要 包括 积分 反 
Lyapunov 稳定 性 定理 可 知 , 为 了 使 系统 浙 近 稳定 , 需 。” 步 控制 器 ， 参 数 自 适 应 器 和 倒立 摆 三 个 部 分 如 图 2 所 示 。 
满足 V<0 。 所 以 只 需 使 仿真 中 倒立 摆 系 统 模型 物理 参数 如 表 1 所 示 。 
Ci +keé)secx =0 (26) 表 1 倒立 所 参数 
A -i Tablel Inverted pendulum parameters 
ztan a i 各 =0 (27) 物理 量 参数 什 
0 小 车 质量 M 0.46kg 
ZE + Ke) cos nx — zi sinx =0 (28) Cae ™ pe Ok 
GA 摆 杆 质心 到 贸 接 点 长 度 1 0.3m 
此 得 到 重力 加 速度 g 9.8m/s’ 
误差 e 的 增益 和 控制 量 z 的 增益 通过 不 断 试 测 ， 分 别 设 
A = +he)secan (29) 置 为 E210，k 二 25 
-0.5 
pr 
65 (Co 
参数 A2 
0.12 ] 
器 
9 输出 F 
摆 杆 角度 稳定 值 xd " 品 | 
10 虚拟 控制 量 z 
参政 加 ns Out1 "中 
让 -一 人 In2 估计 参数 入 1' 
Le 一 一 | In3 Out2 a | 
ee pin4 | a 
_ [| 
积分 反 步 控制 器 硬 | / | 
参数 自 适 应 器 


人 


图 2 MATLAB/Simulink 控制 框图 


Fig.2 MATLAB/Simulink control block diagram 


3.2 仿真 结果 

为 验证 本 文 自 适应 积分 反 步 法 控制 的 快速 准确 性 ， 抗 扰 
动 性 及 适应 参数 不 确定 性 的 能 力 ， 将 其 和 一 般 反 步 法 、 模 糊 
控制 法 及 神经 网 络 控制 法 分 别 在 无 扰动 和 有 扰动 条 件 下 进行 
仿真 实验 ， 然 后 将 实验 结果 进行 对 比 。 模 糊 控 制 系统 为 2 输 
入 1 输出 ， 有 49 条 控制 规则 , 论 域 范围 为 [-10,10]。 神 经 网 络 
控制 为 双 层 网 络 。 


实验 1 无 扰动 时 四 种 方法 的 平衡 控制 
在 初始 角度 为 0.1rad 的 条 件 下 ， 进 行 无 扰动 的 平衡 控制 


实验 ， 结 果 如 图 3 所 示 。 自 适应 积分 反 步 法 、 一 般 反 步 法 、 
模糊 控制 法 及 神经 网 络 控 制 法 四 种 方法 的 稳定 时 间 分 别 为 
1.5s，2.2s,2.5s，3.4s; 稳 态 误差 分 别 为 2.5x10-5rad,3x105 rad， 


5x10-5rad,6.5x10-rad; 超 调 量 分 别 为 0.007 rad,0.015 rad,0.034 
rad，0.044 rad。 结 果 表明 四 种 方法 均 实 现 了 倒立 摆 的 平衡 控 
制 ， 本 文 方法 的 稳定 时 间 比 其 他 三 种 方法 分 别 短 了 0.7s，1s 
和 1.3s， 系 统 收敛 速度 更 快 ， 稳 态 误差 比 一 般 反 步 法 更 小 ， 
超 调 量 也 比 其 他 三 种 方法 小 。 

实验 2 扰动 时 四 种 方法 的 平衡 控制 

为 验证 所 设计 控制 器 的 抗 扰动 能 力 ， 进 行 加 入 扰动 的 平 
衡 控 制 实验 。 系统 稳定 后 加 入 一 个 宽度 为 0.1s, 幅 值 为 0.1rad 
的 脉冲 扰动 , 响应 结果 如 图 4 所 示 。 自 适应 积分 反 步 法 在 4.7s 
时 稳定 ， 相 比 一 般 反 步 法 、 模 糊 控制 法 及 神经 网 络 控制 法 的 
稳定 时 间 分 别 快 了 0.5s，1.2s，2.7s; 同时 其 最 大 波动 幅度 在 
四 种 方法 中 也 最 小 ， 仅 为 0.7rad， 相 比 幅 度 最 大 的 神经 网 络 
控制 1.9rad， 减 少 了 1.2rad; 且 本 文 方法 在 一 个 小 的 波动 后 
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就 稳定 至 0rad， 而 其 他 方法 需 经 历 多 次 
本 文 方法 相 比 于 其 他 几 种 方法 系统 响应 速度 更 快 ， 抗 干扰 能 
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Fig.4 Angle response of pendulum with interference 


实验 3 无 扰动 时 控制 器 的 参数 自 适应 控制 


通过 设置 不 同 摆 杆 初始 角度 0 ， 检 验 自 适应 积分 反 步 法 
适应 性 。 初 始 摆 杆 角 度 为 5*( 实 线 )，10?° 
(虚线 ) 和 15° (点 线 )。 在 MATLAB 中 运行 得 到 仿真 结果 
图 5~10 所 示 。 
5 为 摆 杆 角度 响应 ， 初 始 值 越 大 超 调 也 越 大 。 图 6 为 
使 其 收敛 至 0; 图 7 为 控制 器 输出 
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的 能 力 。 
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其 变化 趋势 与 虚拟 控制 量 z 接近 ;图 8~10 分 别 
图 中 可 以 看 出 3 种 条 件 下 的 
参数 估计 值 在 有 限时 间 内 均 收 敛 至 恒定 值 ， 说 明 根据 系统 状 
适应 控制 器 可 以 在 线 估 计 出 系统 的 不 确定 
使 系统 具备 了 适应 不 同 未 知 参 数 
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图 5 摆 杆 角度 响应 


Fig.5 Angle response of pendulum 
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图 6 虚拟 控制 量 z 


Fig.6 Virtual control volume z 
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Fig.8 Estimated value of parameter 1 
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LabVIEW 实验 


实物 控制 实验 在 LabVIEW 开发 环境 下 进行 ， 实 验 习 
如 图 11 所 示 。 倒 立 摆 控 M 
倒立 摆 摆 杆 及 滑 轨 , 数据 采集 卡 , 计算 必 


。OMRON E6B2-CWZ6C 


4 6 
时 间 /s 


图 10 参数 的 估计 值 
Fig. 10 Estimated value of parameter 
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LabVIEW 程序 主要 包括 输入 模块 , 控 人 
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图 12 所 示 。 图 12 中 黑色 方 
需要 循环 计算 的 控制 器 模块 ， 输 入 模块 和 输出 
模块 。While 循环 的 步 长 为 每 10ms 计算 一 次 。 
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Fig. 11 
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Fig. 12 Labview control system block diagram 
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Fig. 13 Angle response of pendulum without disturbance 
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Fig. 14 Angle response of pendulum with interference 


必 数 据 采 集 卡 传 入 的 包含 编码 器 角度 信息 的 2 路 信和 号， 
言 号 通道 属性 为 角度 位 置 ， 编 码 器 每 转 脉冲 数 为 600， 
站 器 模块 内 封装 了 控制 器 的 VI 程序 。 输 
,其 中 一 路 
机 的 转速 ， 
电机 转动 方向 。“Frequency” 输 
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判 程序 运行 之 前 
框 为 while 循环 


录用 定稿 刘 成 基 ， 等 : 
在 无 干扰 条 件 下 ， 设 定 初始 摆 杆 角度 为 0.2rad， 摆 杆 角 

度 响应 波形 如 图 13 所 示 。 由 图 13 可 以 看 出 : 摆 杆 角度 在 2s 

内 稳定 至 0rad， 期 间 有 小 幅 超 调 ， 幅 度 小 于 0.02rad， 之 后 稳 


定 在 0rad 附近 ， 
定 后 在 4s 时 人 为 
14 所 示 ， 可 以 看 出 系统 的 抗 


待 系统 稳 
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度 高 。 与 仿真 结果 相 比 ， 实物 控制 过 程 稳定 时 间 略 有 滞后 ， 


并 且 有 小 
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统 ， 提 出 了 一 种 


品 超 调 ， 稳 定时 间 基 本 符合 。 
结束 语 


针对 具有 参数 不 确定 性 及 外 界 扰 动 的 直线 单 级 倒立 摆 系 
适应 积分 反 步 控制 策略 。 对 系统 模型 状态 


方 


程 进行 分 析 , 基于 反 步 法 设计 了 系统 的 积分 型 反 步 控制 器 ， 
设计 的 自 适 应 估计 律 可 实现 对 不 确定 参数 的 在 线 估计 。 误 


差 积分 项 的 加 入 使 得 稳 态 误差 相 比 


专 统 反 步 法 更 小 。 在 无 扰 


动 和 有 扰动 条 件 下 的 仿真 和 实物 控制 结果 表明 ， 本 文 设 计 的 

自 适 应 积分 反 步 法 可 以 快速 有 效 地 估计 出 一 组 系统 参数 ， 

弱 了 系统 参数 不 确定 性 的 影响 ， 提 高 了 系统 的 抗 干扰 能 力 ， 
控制 过 程 快 速 准 确 ， 鲁 棒 性 强 。 在 今后 研究 中 ， 将 考虑 数 

学 模型 中 省 略 的 摩擦 项 等 影响 因素 ， 并 结合 其 他 方法 进一步 


改进 控制 器 的 设计 ， 以 达到 更 精确 的 控制 效果 。 
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